/*
 * SonarDrv.c
 *
 *  Created on: 2023-01-20
 *      Author: ma.xw
 */
#include "SonarDrv.h"
#include <S3C2440addr.h>
#include <commlib.h>
#include <eventQueue.h>

#define GPH2_3_MASK (0xF0)
#define MAX_SEND_LEN (256)


void sonar_init() {
    //GPIOのGPG14をECHO
    //rGPGCON 
    //GPIOのGPG13をECHO
}

void wait_sonar_ready() {
    //while(echo)
}

// void read
// 8‘50
// #include <reg51.h>
// sbit ECHO=P1^0;  //超声波的回响信号输出脚
// sbit TRIG=P1^1;  //触发超声波测距的引脚
// u32 timt0_cnt=0; //记录定时器0溢出的次数
// u16 time_val=0;float distance=0.0; //保存测量的距离
// void Timer0_16bit_Init(u16 us);
// void DelayMs(u32 ms);
// void delay20us(void);

// int main(){
    // ECHO=0;      
    // TRIG=0;    
    // UART_Init(); //初始化串口波特率为4800    
    // while(1)    {
        // TRIG=1;//触发测距
        // delay20us(); //延时20us
        // TRIG=0;          //停止触发
        // while(ECHO==0){} //等待回响信号返回
        // Timer0_16bit_Init(65535); //初始化定时器0，并开始计数
        // while(ECHO==1){} //等待回响信号结束
        // TR0=0;           //关闭定时器0
        // time_val=(TH0<<8|TL0)+timt0_cnt*65535; //计算时间
        // distance=time_val/58.0; //得到距离。单位是厘米
        // printf("distance=%f CM\r\n",distance);
        // timt0_cnt=0; //溢出次数清零
        // DelayMs(1000); //延时1秒
    // }
// }

// u16 T0_Update_data;//定时器0的初始值
// void Timer0_16bit_Init(u16 us){ //当前实验板上的晶振实际频率为: 12MHZ
    // u16 val=us/(12/12); //得到计数的时间,只要整数部分
    // T0_Update_data=65535-val; //得到重装载值
    // TMOD&=0xF0;     //清除配置
    // TMOD|=0x01;     //配置定时器0工作在16位定时器模式
    // TH0=T0_Update_data>>8; //定时器0高位重装值
    // TL0=T0_Update_data;    //定时器0低位重装值
    // TR0=1;          //开启定时器0
// }
// extern timt0_cnt; //记录定时器0的溢出次数
// void Timer0_Update(void) {//定时器0的重装值更新函数
    // TH0=T0_Update_data>>8; //定时器0高位重装值
    // TL0=T0_Update_data;    //定时器0低位重装值
    // timt0_cnt++;           //记录定时器0的溢出次数
// }

// void DelayMs(u32 ms){
    // u32 i;
    // u8 a,b;
    // for(i=0;i<ms;i++)    {
        // for(b=199;b>0;b--)
            // for(a=1;a>0;a--);
    // }
// }
            
// void delay20us(void)   //误差 0us{
    // unsigned char a,b;
    // for(b=1;b>0;b--)
        // for(a=7;a>0;a--);
// }
